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Abstract — Accurate vehicular localization is important for 
various cooperative vehicle safety (CVS) applications such as col- 
lision avoidance, turning assistant, etc. In this paper, we propose a 
cooperative vehicular distance measurement technique based on 
the sharing of GPS pseudorange measurements and a weighted 
least squares method. The classic double difference pseudorange 
solution, which was originally designed for high-end survey level 
GPS systems, is adapted to low-end navigation level GPS receivers 
for its wide availability in ground vehicles. The Carrier to Noise 
Ratio (CNR) of raw pseudorange measurements are taken into 
account for noise mitigation. We present a Dedicated Short 
Range Communications (DSRC) based mechanism to implement 
the exchange of pseudorange information among neighboring 
vehicles. As demonstrated in field tests, our proposed technique 
increases the accuracy of the distance measurement significantly 
compared with the distance obtained from the GPS fixes. 

I. Introduction 

Accurate positioning is important for various cooperative 
vehicle safety (CVS) applications such as collision avoidance, 
turning assistant, etc. To enable these applications, the lane 
level accuracy of vehicular positioning is required. However, 
current commercially available GPS devices, which are widely 
used in ground vehicles for navigation tasks, typically report 
tens of meters of positioning errors. Thus, it is difficult to 
recover the lane level relationship among neighbor vehicles, 
which is essential for most of the safety critical applications. 
For example, when a vehicle initiates an emergency brake 
to respond to an unexpected pedestrian, it will broadcast a 
notification message to all its neighbors. On receiving this 
message, it should be the vehicle which immediately follows 
the brake-initiator in the same lane to respond first, even 
though it may not necessarily be the nearest one. As vehicles 
move along the road, their trajectories conform to the multi- 
lane structure of the road. The unique yet important lane level 
relationship makes it imperative to achieve higher positioning 
accuracy for lane level topology recovery. 

Current vehicular localization techniques can be categorized 
into two main classes - absolute position based and relative 
distance based. The techniques used to recover the absolute 
positions of moving vehicles are mostly based on trilateration 
of measured distances to known anchors, such as the cellular 
assisted localization |1) and the Global Positioning System 
(GPS) |2|. Various augmentation techniques have been pro- 
posed to improve the positioning accuracy, including the Wide 
Area Augmentation System (WAAS), European Geostationary 



Navigation Overlay Service (EGNOS) and Differential GPS 
f3\. However, these augmentation systems all require support 
from large-scale infrastructures, and some of them are not 
globally available. Besides these trilateration mechanisms, a 
fingerprint approach |4| is also popular in recovering posi- 
tions of mobile objects using pattern recognition algorithms 
and statistical features of received wireless signals, such as 
from Wifi or cellular tower beacons. The accuracy of these 
techniques depends largely on the granularity of the training 
data set and the accuracy of system calibrations, which are 
time consuming and costly. 

Some applications such as autonomous driving and colli- 
sion avoidance depend more on the relative positions among 
vehicles, instead of their absolute positions. Representative 
techniques to measure the distance between moving vehicles 
include the Received Signal Strength (RSS) SIS, Time 
of Arrival (ToA), and Time Difference of Arrival (TDoA) 
||7 j . However, as stated in |81|10|, these methods can hardly 
achieve the ranging accuracy required by most cooperative 
positioning applications. Alam et. al. proposed a distance mea- 
surement method for cooperative positioning without using 
radio range (SI. It reduces the average distance error to around 
five meters, but this is still not sufficient for lane level topology 
discovery. 

In this paper, a weighted least squares pseudorange dou- 
ble difference algorithm is proposed to further increase the 
accuracy level of GPS based distance detection. The classic 
double difference pseudorange solution, which was originally 
designed for high-end survey level GPS systems, is adapted to 
low-end navigation level GPS receivers for its wide availability 
in ground vehicles. The Carrier to Noise Ratio (CNR) of 
raw pseudorange measurements are taken into account for 
noise mitigation. As demonstrated by field tests, our new 
algorithm greatly improves the accuracy of distance estimation 
and achieves average distance errors of around 3 meters. With 
the improved distance measurements among several vehicles, 
we can then use techniques such as trilateration to determine 
their relative positions. 

The rest of this paper is organized as follows. In Section 
II, we present our weighted least squares pseudorange double 
difference algorithm for estimating distances between two 
vehicles. Performance evaluation is presented in Section III, 
and Section IV concludes the paper and outlines future work. 



ii. pseudorange based cooperative distance 
Detection with Weighted Least Squares Method 

In this section, on the basis of the introduction of double 
difference pseudorange solution, we propose a weighted least 
square algorithm to mitigate the impact of the significant 
noises in pseudorange measurements of commercial GPS re- 
ceivers. In addition, we discuss the DSRC system that enables 
the cooperative distance detection. 

A. Pseudorange Based Distance Detection 

In GPS system, GPS receivers recover their positions by 
trilateration of the measured distances to multiple visible 
satellites. The distance to each satellite is derived from an 
estimated time of transmission, and this distance is called the 
pseudorange. Several sources contribute to the errors in the 
pseudorange measurements. The aggregate impact of these 
error factors can introduce around 10 meters inaccuracy to the 
calculated GPS fixes. The pseudorange measurement between 
GPS receiver a to satellite i can be decomposed into 121: 

where is the true distance between satellite i and receiver 
a; ta is the bias caused by receiver as clock bias; is 
the common noise related to satellite i that are shared by 
all the GPS receivers within a vicinity region, including the 
satellite clock bias, the atmospheric delay, and the error in 
the broadcasted ephemeris; and is the non-common noise 
specific to receiver a and satellite i, including the multipath 
error and the acquisition noise. By taking the difference 
between the pseudoranges of two receivers a and b to the 
same satellite i, the common noise due to satellite i can be 
effectively removed: 

Sab = ^ PRb 

= [K - Rl) + {ta - h) + (eL - 4) 

= ARl, + ita-h) + {el-el) (1) 

where S*^^ is the single difference of pseudorange measure- 
ments, and Ai?^^ is the difference between the true ranges 
from receiver a and b to satellite i. As the true ranges from 
satellite i to GPS receivers a and b are much larger than the 
distance between a and b, the two vectors pointing from z to a 
and b are nearly parallel to each other As illustrated in Figure 
1, AR^^b can thus be approximated by: 

AK, = • Tab 

where is the unit vector pointing from GPS receiver a (or b) 
to satellite i, and fab is the distance vector between receiver 
a and b. When double difference is used, the clock bias of 
receiver a and b can be further removed. 

D% = {PK-PRi)^{PRi-PRi) 

= [AK, - ARi,] + [(4 - 4) - {si - si)] 
= \^-^]-rab + [{el-si:)-{ei-ei)] (2) 



Given known position of either one of the GPS receiver, 
the unit vector of each ? can be calculated using the 
received ephemeris of each target satellite i. Let Dq^ — 
[D^'^ ■ ■ ■ D^^^y denote the column vector of pseudo- 

range double differences, and there are totally n + 1 satellites 
shared by receiver a and b. Eq. |2] can be reorganized into: 

T>ab = ^Tab + e (3) 

where H = [(e^ - e«) (e^ - ^) • • • {e^ - , and e is the 
column vector of aggregated non-common noises related to the 
two satellites and two receivers involved. If e can be assumed 
to be zero mean and equal variance, -Fab can be derived by the 
linear least squares estimator 

Tab = (H^H)-iH^D„f, (4) 

as long as there are at least four shared satellites between the 
two GPS receivers. 

Comparing with the around twenty thousand kilometers 
distances from satellites to vehicular GPS receivers, tens of 
meters positioning error to the GPS receiver a or & can be 
fairly ignored when calculating the unit vectors of Thus, 
(? can be calculated by directly using the final output of the 
GPS fix of either one of the two GPS receiver modules. 

Satellite 1 




Fig. 1. Pseudorange double difference 

B. Weighted Least Squares Approach 

In eq. [3] e is the aggregated non-common noises of pseudo- 
range measurements including both the multipath and random 
code acquisition errors encountered by the two GPS receivers. 
It's ith item is equal to 

= (4 - 4) - {el - el) (5) 

In scenarios where multipath effect is not severe, for exam- 
ple when vehicles are moving along highways, e are dominated 
by code acquisition errors, which can be directly linked to 
the Carrier to Noise Ratio (CNR) of the received satellite 
signal. With commercial and navigation level GPS receivers, 
the accuracy of code acquisition is much worse than survey 
level devices. It can introduce more than ten meters of errors 
to the pseudorange measurements and thus severely degrade 
the accuracy of double difference based distance detections. 



TABLE I 

The impact of Carrier to Noise Ratio to double difference based distance detection 





CNR Threshold (dBHz) 


47 


46 


45 


44 


43 


42 


41 


40 


35 


30 


Baseline distance 
of 3 meters 


Average Distance Error (m) 


0.983 


3.049 


4.241 


4.286 


4.301 


4.868 


4.492 


4.384 


4.429 


5.265 


Number of Valid Samples 


14 


362 


2339 


3736 


4212 


4713 


5056 


5175 


5503 


5516 


Baseline distance 
of 8 meters 


Average Distance Error (m) 


0.030 


4.3318 


5.170 


5.487 


5.756 


5.708 


5.773 


5.394 


4.124 


5.174 


Number of Valid Samples 


10 


636 


2529 


4137 


4794 


5233 


5414 


5567 


5711 


5769 



Table U gives the experimental results of filtering pseudo- 
range data with a CNR threshold. It shows the relationship 
among the accuracy of the calculated distances using normal 
least squares algorithm, the CNR threshold for pseudorange 
measurements, and the number of valid samples. Detailed 
settings of the experiment are elaborated in Section |llll A 
set of CNR thresholds are used to choose valid pseudor- 
ange measurements for least squares based double difference 
processing. The satellite with the best CNRs to both of the 
GPS receivers is selected as the reference. As shown in 
the table, a higher CNR threshold gives higher accuracy of 
distance detection. However, as it is not always possible to get 
enough (four or more) pseudorange measurements with high 
CNRs, the number of valid samples decreases accordingly, 
which implies substantial delays between successive distance 
measurements. 

To address this problem, a CNR based weighted least 
squares method is adopted to takes into account the differ- 
ent accuracy level of different pseudorange measurements in 
estimating the distance. With non-equal variances of each e'\ 
the weighted least squares estimator 



If no candidate satellite reaches the threshold of CNRref, 
the whole set of measurements are dropped and no distance 
calculation is done for this round. With a selected high-CNR 
reference satellite, which is indexed as satellite 0, e' can then 
be approximated as: 

(8) 

After the successful selection of the reference satellite, the 
matrix H and the column vector Dab are determined. The only 
unknown left for the left side of Eq. |6]is the weight matrix of 
W. With known CNR 0^ of the received signal from satellite 
i to GPS receiver a, we assume that the variance (cr*)^ of 
£^ is reversely proportional to the value of i/i^ (in dBHz), i.e. 
(ct* )^ oc i/4>a- As ejj and el are independent from each other, 
the variance (cr*)^ of each can thus be derived as; 

K)' = Kr + «r (9) 

and the weight matrix W can then be finalized as 



Tab = (H^WH)-iH^WDab (6) 

can be used as the best linear unbiased estimator (BLUE), 
where the weight matrix W is the inverse of the covariance 
matrix of e. The following strategy is proposed to implement 
the weighted least squares method and improve the perfor- 
mance of pseudorange based distance detection. 

First of all, a satellite is selected from all the candidate 
satellites as the reference for double difference calculation. 
As shown in Eq. |5] if the variance of (e° — e°) can be kept 
small, it can be fairly assumed that the e's are uncorrelated 
and W can thus be simplified as 

W = diag{j^r- - (7) 

where diag{-) denotes a diagonal matrix and ct* is the standard 
deviation of e*. With independent and zero mean random 
variables of £° and e", the only way to keep — e°) small 
is to keep the standard deviation of both £° and small. 
It is thus better to select the satellite with the best CNRs to 
both of the two receivers as the reference satellite for double 
difference. To eliminate the impact of noisy measurements 
from reference satellites, a threshold of CNRref is used to 
set an upper limit to the noise level of the reference satellite. 



Last, in selecting candidate satellites, a threshold CNRmin 
is used to prevent pseudorange measurements with too much 
noises from being used in the double difference calculation. 
Only those satellites with better signal qualities than CNRmin 
can be selected as candidates for consequent processing. 

C. DSRC Assisted Cooperative Distance Detection 

In applying the proposed pseudorange based cooperative 
distance detection technique to vehicular systems. Dedicated 
Short Range Communications (DSRC) are needed to exchange 
raw pseudorange information among neighboring vehicles. 
The periodical pseudorange measurements can be piggybacked 
into the DSRC heartbeat messages. As the feasibility of 
double difference algorithm depends largely on synchronized 
pseudorange measurements among different GPS receivers, 
it is recommended that all the GPS receivers conduct their 
pseudorange measurements with a same fixed time frequency 
and according to a same fixed time offset. For example, they 
can conduct their pseudorange measurements at the beginning 
of every GPS second and output their measurements once 
every second. As different satellites have different signal 
propagation time, measurement interpolations may be needed 



to ensure local synchronization among all the pseudorange 
measurements of different satellites. 

Upon finishing each round of pseudorange measurement, 
the vehicle selects the candidate pseudorange measurements 
that have better CNRs of the receiving signal than CNRmin- 
Among these candidate pseudoranges, the measurement with 
the best CNR is picked up. If the number of candidate mea- 
surements is less than four or when the best measurement has a 
CNR less than CNRref , no information will be piggybacked 
and broadcasted this round. Otherwise, the GPS time tag and 
all the candidate pseudorange measurements as well as their 
CNRs are piggybacked to the end of heartbeat message and 
broadcasted to all the one-hop neighbors. The format of the 
attached message is illustrated in Figure |2] 



GPS Time 


Satellite Bitmap 


PR 1 


CNR 1 


PR 2 


CNR 2 




Bytes : 4 


4 


8 


1 


8 


1 



Fig. 2. Format of the piggyback message 

The 4-byte Satellite Bitmap field is made up of 32 ON/OFF 
flags, indicating the presence of the pseudorange measure- 
ments of the corresponding satellites in the following message. 
Each measured pseudorange (PR) is represented by a 8- 
byte double-precision floating-point data. When there are n 
candidate satellites, the total length of the attached message is 
/ = 8 + 9 X n bytes. With four candidate satellites, which meets 
the minimum requirement, the attached message is 44 bytes. 
The same set of information is copied and cached locally 
together with the output of GPS fix for later processing. 

Upon receiving a heartbeat message with piggybacked pseu- 
dorange information from a one-hop neighbor, the receiving 
vehicle checks the GPS time tag and picks the matching set 
of measurements from its local cache for processing. Among 
these two sets of pseudorange measurements, those shared 
satellites are selected. If the number of shared satellites is 
less than four, or if there is no satellite satisfies the CNRref 
threshold, the received information is simply dropped without 
calculating the distance. Otherwise, the satellite with the best 
CNRs to both of the two receivers is selected as the reference, 
and the distance is calculated using the proposed algorithm. In 
building the matrix of H, the cached local GPS fix is used, and 
the satellite position is calculated using local almanac data. 

III. Experiments and Results 

To validate the performance of the proposed algorithm, two 
field experiments are conducted. In these experiments, two 
GPS receivers with SiRFstar III module are placed on a roof 
top with distances of three and eight meters apart respectively. 
The SiRF proprietory binary protocol |9| was used to extract 
the raw pseudorange measurements, satellite positions, esti- 
mated GPS time, as well as the calculated GPS fix. Pairs of 
independent measurements with the same estimated GPS time 
are taken out from the two modules for subsequent processing. 
The CNRs of all pseudorange measurements are also extracted. 



and only those with CNR greater than CNRmin are used 
for distance calculations. The CNRmin threshold is set to 
30dBHz, and the CNRref threshold is set to 47dBHz. 

Figures [3] and |4] show the performance of the weighted least 
squares pseudorange double difference algorithm in the two 
experiments. The distance derived by the proposed algorithm is 
compared with the distance calculated direct from the two GPS 
fixes generated by the two GPS modules. As demonstrated in 
the two figures, the weighted least squares double difference 
method greatly improves the accuracy level of GPS based 
distance detection. Even when the GPS measurements are 
severely affected by random noises as shown in the first 
1000 samples of the two figures, the proposed algorithm can 
still provide a decent average noise of less than ten meters, 
whereas the GPS fix based algorithm goes wrong as far as 
tens of meters. Although there are still some distance error 
spikes around twenty meters level, they are unlikely to be 
directly used for lane level vehicular positioning. Compared 
with the distance errors calculated from the GPS fixes, which 
are around fifty to seventy meters, the proposed solution 
shows the remarkable performance improvement. Advanced 
postprocessing algorithm, such as kalman filters, can be used 
to further improve the performance by filtering out such 
measurement disturbances. 

Performance of Distance Detection witfi 3 Meters Baseiine 
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Fig. 3. Experiment results 



Table Ull gives an overall performance comparison of differ- 
ent GPS based algorithms in distance detection. There are five 
algorithms compared, including GPS fix based algorithm, least 
squares single difference (LS-SD), least squares double differ- 
ence (LS-DD), weighted least squares single difference (WLS- 
SD), and weighted least squares double difference (WLS- 
DD) algorithms. With single difference based algorithms, the 
difference of clock bias related range bias {ta — h) is set 
as the fourth dimension of the unknown vector in addition to 
the three dimensions of the baseline vector Tab- This unknown 
vector can be derived in similar ways as with double difference 
method. It can be solved with either normal least squares based 
algorithm or weighted least squares based algorithm. For fair 
comparison, the results of GPS fix based algorithm and single 



Performance of Distance Detection with 8 Meters Baseiine 
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TABLE II 

Average Distance Errors (m) with Different Algorithms 
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Fig. 4. Experiment results 



difference based algorithms are averaged over the same set 
of samples that are eligibly selected by the double difference 
based algorithms. The average distance error is calculated by: 



Ad- 



M 



M 



(11) 



where M is the total number of valid samples, and is the 
true baseline distance. 

As shown in Table |ll] when the GPS fixes are directly used 
for distance calculation, the average distance errors are more 
than 12 meters. In contrast, the distance errors are dramatically 
decreased to less than 7 meters for the other cooperative 
algorithms where the raw pseudorange measurements are used. 
In particular, with normal least squares algorithm, the single 
difference method results in average errors of 5.668 meters 
and 6.505 meters, which gives around 50% improvements 
comparing to GPS fix based method. When double difference 
is used, the average error further decreases by about 1 meter 
These improvements are due to the decreased dimension of 
the unknown variable comparing with the single difference 
method. When the weighted least squares method is used, 
which takes into account the signal quality of each pseu- 
dorange measurements, the performance is further improved. 
Even with single difference, the average errors decrease by 
about 1 meter comparing with using double difference with 
normal least squares method. When double difference is used 
together with weighted least squares method, the average er- 
rors reach the least values of 3.192 meters and 3.641 meters in 
the two experiments. The overall performance improvements 
comparing with GPS fixed based method are more than 70%. 

As mentioned previously, our proposed algorithm is most 
effective when the code acquisition errors are the dominant 
errors in the GPS signal. On the other hand, if there is severe 
multipath, the performance of our algorithm would be close 
to that of the least squares double difference algorithm. 
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IV. Conclusions and Future Work 

In this paper, we proposed a weighted least squares pseu- 
dorange double difference algorithm for cooperative distance 
measurement in vehicular networks. It makes use of the 
existing GPS receivers in each vehicle and DSRC-based vehic- 
ular networks for accurate distance measurement. With com- 
mercially available GPS receivers, our technique can greatly 
eliminate the impact of those random noise in coarse code 
acquisition, and reduce the distance estimation error to about 
3 meters, which is a great improvement compared with using 
GPS fixes directly. 

The current solution is effective in scenarios where the 
dominant errors come from the code acquisition. In our future 
work, the influence from the multipath effect as well as the 
countermeasures will be further examined. With the improved 
distance estimation accuracy, we aim to recover the lane level 
relative relationship among neighboring vehicles by develop- 
ing advanced cooperative vehicular positioning techniques. 
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